direct kinematic problem

运动学直接问题